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ABSTRACT 

With  the  increased  demands  for  higher  productivity  in  industry  and  the  military, 
control  of  Robot  Manipulators  with  flexible  joints  is  needed.  The  difficulties  associated 
with  the  control  of  flexible  joint  robots  include  the  following:  (1)  Nonlinearity  of  the 
arm  motion  (2)  Coupled  large  motion  (motion  of  the  motor)  and  small  motion  (me- 
chanical vibration)  and  (3)  measurements  of  feedback  signals.  This  theis  presents  an 
controller  designed  to  handle  the  difficulties  related  to  flexible  joint  robots.  The  third 
joint  of  the  PUMA  560  Robot  was  selected  as  an  example.  A  control  algorithm  for 
flexible-body  control  was  devised  and  an  observer  was  designed  with  the  use  of 
MATRIX^,  to  control  tip  motion  of  the  single-link  single-joint  system.  Computer  simu- 
lation results  are  discussed,  and  a  comparison  between  rigid-body  controllers  and  the 
flexible-bodv  control  is  conducted. 
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I.     INTRODUCTION 

A.  ROBOT  MANIPULATOR  USES 

There  is  an  increasing  trend  within  the  United  States  Navy  towards  applications  that 
utilizes  robots  to  perform  tasks  which  are  considered  routine  or  dangerous  for  humans 

to  perform.   These  tasks  include: 

1.  Under- water  research  and  exploration 

2.  Fire  fighting 

3.  Battle  field  logistic  vehicle 

4.  Perimeter  patrol 

5.  Under-water  autonomous  vehicle 

Robotic  submersibles  are  being  studied  and  tested  to  be  used  to  explore  areas  of  the 
oceans  that  are  presently  too  hazardous  for  man  to  explore.  There  is  also  a  large  po- 
tential for  the  use  of  robots  in  space. 

All  the  applications  listed  require  close-loop  automatic  control  that  typically  lead 
to  manpower  reductions,  improvements  in  stability  and  response. 

In  addition,  the  robotic  manipulators  currently  installed  in  industry  also  have  the 
potential  for  improvement  in  the  areas  of  increase  accuracy,  performance,  as  well  as 
weight  to  load  capacity  and  productivity.  The  enhance  performance  must  come  with  a 
realized  savings  in  cost  and  reduction  both  in  energy  consumption  and  overall  physical 
plant  size. 

B.  BACKGROUND 

Most  work  in  the  past  have  centered  on  rigid  body  manipulators  until  recently  when 
flexible  body  manipulators  began  to  show  great  potential  in  industry. 
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Control  systems  for  industrial  robots  are  currently  designed  using  mathematical 
models  in  which  the  links  and  drive  trains  are  assumed  to  be  rigid  [Ref.  1:  p.  196].  The 
joint  positions  are  controlled  independently,  using  position  and  velocity  feedback  from 
sensors  located  at  the  joint  actuators. 

However,  improvements  in  dynamic  response  and  payload  to  weight  ratio  require 
that  the  flexibility  effects  be  taken  into  account  in  the  modeling  stage  and  incorporated 
into  the  controller  design.  Preliminary  results  of  studies  of  link  structural  flexibility 
versus  drive  train  compliance  for  several  industrial  robots,  indicated  that  structural 
flexibility  accounts  for  2  -  20%  of  total  arm  compliance.  If  the  structural  flexibility  of 
the  arm  is  small  relative  to  the  drive  train  flexibility,  then  the  arm  could  be  represented 
by  a  rigid  body  model  with  "compliance  lumped  between  the  actuators  and  links." 
[Ref.   1:  p.  196] 

Drive  train  flexibility  plays  a  critical  role  in  robot  motion  control  design.  It  has  been 
shown  that  closed  loop  speed  response  of  the  manipulator  can  be  increased  beyond 
typical  industrial  practices  by  considering  the  drive  train  compliance  in  the  design  and 
providing  suitable  feedback  measurement  [Ref.  1:  p.  197].  Using  a  lumped  parameter 
model,  Forrest-Barlach  and  Babcock  [Ref.  1:  pp.  196-197]  studied  the  effects  of  drive 
train  compliance  and  actuator  dynamics  by  modeling  a  two  DOF  manipulator  and  de- 
signing a  position  controller  based  on  inverse  dynamics.  Simulation  of  various  control- 
lers were  performed  utilizing  the  Advance  Continuous  Simulation  Language.  Their 
inverse  dynamics  control  law  is  based  on  the  concept  of  "computed  torque."  This 
method  decouples  the  motion  of  the  arm  when  drive  train  compliance  and  actuator  dy- 
namics are  considered.  The  "computed  torques"  concepts  are  utilized  to  determine  the 
required  input  torques  as  functions  of  jerk  rate,  jerk,  acceleration,  velocity  and  position 
errors.  Jerk  rate  is  a  fourth  ordered  term.  The  ITAE  performance  criteria  for  pole 
placement  is  used  to  minimize  the  error  between  the  desired  and  the  actual   state 


measurements  [Ref.  1:  p.  200].  They  concluded  that  in  general  after  comparative 
simulations,  the  inverse  dynamics  controller  performance  was  superior  to  that  of  the 
other  controllers  they  tested  due  to  its  ability  to  decouple  the  arm  motion 
[Ref.   1:  pp.  200-203]. 

The  simulation  study  was  conducted  without  considering  practical  limits  on  avail- 
able motor  torques.  Forrest-Barlach  and  Babcock  concluded,  limitation  in  available 
torques  will  significantly  affect  system  response.  Therefore  Forrest-Barlach  and  Babcock 
felt  the  effect  of  torque  limiting  on  the  relative  performance  of  the  controllers  should  be 
evaluated  by  selecting  appropriate  torque  limits  for  the  specific  motors. 
[Ref.  1:  pp.  203-204] 

In  another  study,  Marino  and  Spong  [Ref.  2:  p.  1030]  found  joint  elasticity  is  the 
dominant  source  of  compliance  in  most  current  manipulator  designs.  This  joint  flexi- 
bility may  arise  from  gears,  belts,  links,  bearings,  and  hydraulic  lines  and  limit  speed  and 
dynamic  accuracy  achievable  by  control  algorithms  designed  assuming  perfect  rigidity 
at  the  joints.  The  nonlinear  control  problem  using  a  single  link  manipulator  with  joint 
elasticity  were  studied. 

In  their  work,  two  nonlinear  control  techniques  to  control  the  manipulator:  (1) 
feedback  linearization  design  and  (2)  composite  control  design  were  used.  It  was  found 
that  feedback  linearizing  control  required  full  state  measurements  which  in  their  case 
included  the  velocities  of  both  the  link  and  the  motor  shaft.  Whenever  part  of  the  state 
was  not  accessible  for  measurements,  problems  were  created.   [Ref.  2:  pp.  103 1-1035] 

Based  on  extensive  analytical  and  experimental  studies  by  Sweet  and  Good 
[Ref.  3:  pp.  724-727],  realistic  robot  dynamic  models  have  been  presented  which  has 
been  validated  over  the  frequency  range  from  0  to  50  Hz.  These  models  exhibit  a  strong 
influence  of  drive  train  flexibility,  producing  lightly  damped  poles  in  the  neighborhood 
of  8  Hz,  14  Hz,  and  40  Hz,  all  unmodeled  by  the  conventional  rigid  body  multiple  link 


robot  dynamic  approach.  They  also  noted  the  significance  of  drive  train  and  mechanical 
flexibility  had  been  recognized  in  only  a  few  prior  papers.  One  approach  they  used  to 
improve  robot  motion  control  performance  was  to  decouple  the  dynamics  of  the  robot 
links  through  nonlinear  control.  The  decoupling  action  performed  by  the  controller  was 
particularly  significant  in  the  same  frequency  range  where  resonant  behavior  occurs 
which  was  present  in  the  robot  motion  control  loop  of  electro-mechanical  drives  with 
flexibility  in  series  with  the  load.  Sweet  and  Good  also  realized  the  existence  of  drive 
train  interactions  did  not  dismiss  the  idea  of  using  nonlinear  or  decoupling  control 
strategies,  but  it  required  the  use  of  realistic  drive  train  models  in  the  development  of 
usable  algorithms.  Also  they  found  high  gear  ratios  employed  in  most  drive  units  causes 
the  torques  resulting  from  cross-coupling  effects  as  reflected  back  to  the  motors  to  be 
minimal  [Ref.  3:  pp.  725-726]. 

In  a  separate  design  study,  Spong  [Ref.  4:  p.  312]  investigated  a  second  method  of 
approach  to  control  elastic  joint  manipulators.  The  second  method  is  based  on  the  "in- 
tegral manifold  formulation"  of  the  equation  of  motion.  One  advantage  of  this  approach 
as  noted  by  Spong,  is  it  can  be  applied  when  only  the  link  position  and  velocity  are 
available  for  feedback.  Spong  concluded  at  the  end  of  his  evaluation  that  by  using 
global  feedback  linearization,  the  nonlinearities  in  the  system  do  not  have  to  be  com- 
puted exactly  but  rather  once  the  proper  coordinates  are  found  in  which  to  represent  the 
system,  the  so  called  matching  conditions  can  be  satisfied.  In  other  words  the  nonline- 
arities are  all  in  the  range  space  of  the  input.  He  further  realized  realistic  limitations  on 
motor  torques  can  prevent  the  arm  from  reaching  velocities  of  sufficient  magnitude  for 
cross-coupling  terms  to  become  significant,  but  realistic  trajectories  for  robot  arms  in 
actual  manufacturing  applications  rarely  require  extremes  of  velocity  and  acceleration 
[Ref.  4:  p.  310].  He  finally  concluded  the  integral  manifold  based  corrective  control 
method  needed  further  investigation  [Ref.  4:  pp.  314-318]. 


The  objectives  of  the  above  work  have  been  the  study  of  the  nonlinear  control 
problem  for  a  robot  manipulator  with  joint  elasticity.  Much  of  the  past  research  in 
robotics  modeled  the  robot  manipulator  as  a  rigid  joint  and  did  not  consider  joint 
elasticity.  But  recent  studies  have  found  joint  elasticity  is  the  dominant  source  of  com- 
pliance in  most  current  manipulator  designs.  It  was  their  intention  to  illustrate  several 
nonlinear  control  techniques  to  solve  this  control  problem  of  joint  elasticity.  Their  re- 
search provides  the  background  for  the  investigation  of  a  computed  torque  controller 
structure  which  considers  drive  train  flexibility  of  a  single  link  manipulator. 

In  this  work,  the  computed  torque  controller  will  be  enhanced  and  evaluated.  The 
"computed  torque"  concept  requires  the  values  of  the  second  and  third  derivatives.  Since 
these  values  can  not  be  measured  from  the  plant,  an  observer  or  estimator  will  be  de- 
signed as  part  of  the  controller  to  provide  the  estimates  of  these  unmeasurable  values. 

C.     METHOD 

The  flexible  manipulator  offers  low  power  consumption,  ease  of  transportation,  re- 
duced material  requirement,  lower  mounting  strength  and  rigidity  requirement,  and 
lower  overall  cost  [Ref.  5].  To  meet  the  needs  of  a  light-weight  manipulator  having 
greater  performance  capabilities,  certain  problems  must  be  solved  in  order  to  fully  utilize 
the  flexible  manipulator. 

The  model  must  adequately  describe  the  system  and  yet  it  must  be  simple  enough 
to  implement  in  order  to  design  an  adequate  controller  for  the  computation  purpose. 

The  controller  in  this  thesis  is  designed  by  using  the  technique  called  the  inverse 
dynamics  control  law  based  on  the  concept  of  "computed  torque".  This  control  ap- 
proach represents  a  method  of  decoupling  the  arm  motion  when  drive  train  compliance 
and  actuator  dynamics  are  considered.  A  single  fevolute  joint  was  modeled  for  this  re- 
search.   [Ref.   1:  pp.  196-197] 


First  the  plant  will  be  discussed  in  Chapter  III  and  the  controller  design  procedure 
will  be  developed  in  Chapter  IV.  The  parameters  of  the  third  flexible  joint  of  the  Puma 
560  Robot  was  used  in  the  design  procedures  (Figure  1).  A  rigid  body  controller  is 
currently  installed  in  the  control  loop  of  the  Puma  560  robot.  A  description  of  the  Puma 
560  Robot  is  found  in  Appendix  B.   [Ref.  6:  p.  1-27] 

The  MATRIX*!  computer  software  was  used  for  the  modeling  of  the  controller  and 
the  plant  and  the  software  was  installed  on  the  Vax  computer  system.  MATRIX*  is  a 
software  package  for  modeling,  simulation,  engineering  analysis,  control  design  and 
system  identification.   A  description  of  MATRIX*  can  be  found  in  Appendix  A. 


1  MATRIX*  is  a  trademark  of  Integrated  Systems  Incorporated. 
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Figure  1.      Joint  3  PUMA  Robot  Ann 


II.     PROBLEM  STATEMENT 

A.  INTENTIONS 

In  the  design  of  robot  manipulators,  controlling  the  tip  position  is  of  major  concern. 
The  end  effector  (robot  tool)  is  attached  to  the  tip  position  and  through  it  performs  the 
function  of  the  robot  arm.  The  second  consideration  is  the  small  oscillation  (small  mo- 
tion) between  the  arm  position  and  the  motor  position. 

Figure  2  shows  a  single-link  manipulator  with  joint  flexibility,  consisting  of  an 
actuator  (DC  motor),  a  transmission  line,  and  a  rigid  single  link.  The  transmission  line 
includes  a  flexible  helical  spring  coupling  and  the  indicated  gears.  The  transmission 
line's  flexibility  is  the  cause  of  the  difference  between  arm  position  and  motor  position. 

It  is  the  intent  of  this  research  to  design  a  controller  which  can  accurately  control 
the  tip  position  and  also  account  for  and  minimize  the  small  oscillation  (small  motion) 
of  the  system. 

B.  PROCEDURE 

This  research  is  conducted  in  three  phases. 

First,  using  Lagrangian  dynamics  approach,  a  mathematical  model  of  the  flexible- 
body  model  plant  is  derived.  Next  the  flexible-body  controller  is  designed  using  the 
concept  of  control  law  along  with  designing  a  state  observer. 

Second,  considering  the  special  case  of  rigid-body  control,  a  comparison  between  the 
two  methods  of  feedback,  motor  feedback  and  arm  feedback,  is  conducted  with  the  best 
method  of  feedback  control  selected  to  continue  comparison  test  and  analysis. 

Third,  after  determining  that  the  past  method  of  control  could  be  improved  on  by 
a    flexible-body    controller,    comparison    tests    are    conducted    between    the    selected 
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Figure  2.      Single-Link  Manipulator  with  Joint  Flexibility 


rigid-body  controller  and  the  flexible-body  controller.    A  determination  is  made  at  the 
end  to  show  how  much  the  flexible-body  controller  improves  plant  operation. 

Flexibility  of  the  gear  train  will  be  considered  in  this  research  work  but  gear  back- 
lash will  be  neglected  for  now.  Various  simulation  runs  will  be  conducted  with  various 
parameters  to  study  the  dynamic  flexibility  behavior  of  the  control  system.  An  investi- 
gation of  the  special  case  of  a  rigid-body  controller  controlling  a  flexible  body  plant  will 
be  observed  and  compared  with  the  simulation  results  of  the  flexible-body  controller. 
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III.     PLANT  MODELING 

A.     EQUATIONS  FOR  PLANT 
1.     Flexible  Body  Model 

Due  to  its  systematic  approach,  the  Lagrangian  dynamics  approach  is  used  to 
derive  the  equations  of  motion.  The  total  kinetic  energy  is  comprised  of  the  individual 
kinetic  energies  of  the  link,  actuator,  and  any  applied  forces.  The  total  potential  energy 
of  the  system  is  comprised  of  the  elastic  strain  energy  of  the  link  and  the  potential  energy 
due  to  gravity.  Generalized  forces  are  made  up  of  any  applied  forces  and  damping 
forces.  Through  mathematical  manipulations  and  simplifications,  two  sets  of  coupled 
non-linear  equations  are  derived.   [Ref.  7:  pp.  239-254] 

Consider  a  single  revolute  joint  (Figure  2),  consisting  of  an  actuator  (DC  mo- 
tor) whose  rotor  inertia  Jm  is  connected  through  a  transmission  link  to  a  rigid  link  with 
inertia  Ja  about  the  axis  of  rotation.  The  transmission  line  consist  of  a  flexible  helical 
spring  coupling  and  the  gears  shown.  The  transmission  line  has  a  spring  with  stiffness 
k  and  the  gear  ratio  is  equal  to  G,. 


Angle  in  Motor  Side 
Gr  = 


Angle  in  Arm  Side 

The  generalized  coordinates  includes  the  link  angle  8C  and  the  motor  shaft  angle  6m  . 
The  following  relationships  will  apply  in  the  derivation  of  the  plant  model: 

0aGr    -    Bm    =    5  (deflection)  (3.1) 

Since  the  motion  of  the  link  is  a  pure  rotation  about  the  motor  axis,  the  kinetic 
and  potential  energies  are: 
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(KE)  =   i-J^  +   \im62m  (3.2) 


(PE)  =   \k{OaGr  -  Bj  +  magj-(l  -    sintfj  (3.3) 

Where  m,  is  the  total  mass  of  the  arm  (link)  and  —  is  the  distance  from  the  axis  of  ro- 
tation to  the  center  of  mass  of  the  arm. 

The  equations  of  motion  are  found  from  the  Lagrangian  method  to  be: 


]ada  +  k(8aGr  -  0m)  +  ma£ycos0a  =  O  (3.4) 


]m6m  -  k(daGr  -  6m)  =  T  (3.5) 

Where  T  is  a  generalized  force  applied  to  the  transmission  line  through  the  actuator. 
[Ref7:  pp.  259-261] 

See  Figure  3  for  a  block  diagram  of  the  Flexible  Body  model  plant. 
2.     Rigid  Body  Model 

For  the  special  case  of  a  rigid  body  model,  the  following  assumptions  are  made 

(refer  to  Equations  3.2  and  3.3)  [Ref.  2:  p.    1030]: 

1.  K  — »  oo 

2.  The  elastic  displacement  6a  —  Bm    -*    0 

Therefore  the  kinetic  and  potential  energies  equations  for  the  rigid  body  case 
reduces  to: 


ke  =  \{}a  +  jjel 

,  (3.6) 

PE  =  magy(l  -    sinflj 
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Figure  3.      Flexible  Body  Model  Flant 
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Referring  back  to  Equations  (3.3)  and  (3.4),  The  Lagrange  equations  reduces  to: 


(J,  +  Jm)da  +  mag^-cos6a  =  T  (3.7) 


The  only  nonlinearity  term,  cos  6B,  appears  in  Equations  (3.4)  and  (3.7). 

B.     ADDED  MASS  AND  DAMPING 

The  additional  special  case  of  added  mass  and  damping  can  be  modeled  into  the 
plant  by  adding  the  appropriate  terms  to  Equations  (3.4),  (3.5),  and  (3.7)  (see  Appendix 
C  for  an  explanation  and  derivation  of  the  added  mass  and  dampening  equations). 

With  the  model  of  the  plant,  a  controller  for  the  flexible  joint  plant  is  designed  as 
well  as  a  a  special  case  where  the  joint  is  considered  rigid.  A  rigid  body  controller  is 
designed  to  test  its  ability  to  control  a  plant  with  flexibility  effects  present.  The  design 
of  the  controller  will  be  discussed  in  Chapter  IV. 
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IV.     CONTROLLER  DESIGN 

A.     CONTROL  LAW 
1.     Derivation 

The  controller  is  designed  using  the  following  steps  [Ref.  1:  p.  200]: 
The  dynamic  equation  of  motion,  equation  (3.4),  can  be  solved  for  the  motor 
position  in  terms  of  the  arm  position: 


6m   -    RaGr   +   Ja  ~T"     + 


0„  rrur/ 


2k    C0S^ 


(4.1) 


Next  differentiating  Equation  (4.1)  twice  with  respect  to  time  yields  the  following: 


$m    = 


rnag7 


°°--ire«cose«+-ir 


(4.2) 


Substituting  Equation  (4.2)  back  into  Equation  (3.5)  results  in  the  following: 


T    T  R 

J  mJa"a 


+  F  =  T 


(4.3) 


where 


F  =  3, 


Gr — 2k~ 


+  ]ada  +  mag  —  cosda 


(4.4) 


See  Figure  4  for  the  block  diagram  of  the  F  equation.    Equation  (4.3)  is  a  fourth  order 
differential  equation  in  terms  of  the  arm  variables  alone. 
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Next,  the  concept  of  computed  torque  is  utilized  to  determine  the  desired  input 
torques  as  a  function  of  the  fourth  and  third  derivatives,  acceleration,  velocity,  and  po- 
sition errors.   The  desired  input  torque  can  be  written  as: 


Td  =  ^[ed  +  K2(ed-d)  +  K2(ed-e)  +  K,(ed-e)  (4  5) 

+  Ko(^-0)]  +  F 


where  the  K's  are  constants  representing  state  error  feedback  gains.  Assuming  the  non- 
linear F  equation  terms  can  be  computed  based  on  plant  dynamics  and  the  availability 
of  measurements,  equating  Equation  (4.3)  and  Equation  (4.5)  together  results  in: 


ist  [(£  _  ed)  +  k3(0  -  ed)  +  K2(e-  ed)  +  k,  (e  -  ed) 


(4.6) 

+  k0(#  -  ed)i  =  o 


Since  Jm,  Ja,  and  k  are  non  zero,  Equation  (4.6)  becomes: 

"e    +    K3£    +    K2£    +    Kj£    +    K0c    =    0  (4.7) 

where 

e   =   (0   -   dd) 

is  the  position  error.  As  time  -»  oo  ,  the  steady  state  position  error 
c  =  (0  —  $d)  ->  0  (note  this  is  true  for  specific  K's  obtained  using  the  ITAE  perform- 
ance criteria)  [Ref.  1:  pp.  200-201]. 

ITAE  performance  criteria  for  a  fourth  order  equation  is  used  for  the  selection 
of  the  K  values.  The  values  are: 
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K3  =  2.\con 

K2  =  3.4(x)2n 

3  (4.8) 

K,  =  2.7w„ 

K0  =  l.OoiJ 


a>„  represents  the  selected  servo  input  speed  to  the  system.   [Ref.  8:  pp.   129-130] 
A  block  diagram  of  the  Flexible  Body  Controller  is  shown  in  Figure  5. 
2.     Special  Case  of  Rigid  Body  Model 

Referring  back  to  equation  (3.7),  one  can  see  a  controller  for  the  Rigid  Body 
case  can  be  developed  along  the  same  lines.    Define  the  desired  input  torque  equation 


as: 


T,  =  (J*  +  J«)^  +  Kv(bd  -  6)  +  Kp(0d  -  6)  +  F  (4.9) 


where 


F  =  mag-Jrcosd  (4.10) 


Equating  equations  (3.7)  and  (4.9)  together  and  dividing  out  the  non  zero  terms,  the 
following  results: 

I    +    Kv£    +    K,c    =    0  (4.11) 

To  let  this  steady  state  error  approach  zero,  K„  and  Kp  should  be  properly  chosen.  A 
block  diagram  of  the  Rigid  Body  Controller  is  shown  in  Figure  6.  See  Figure  7  for  a 
block  diagram  of  the  Rigid  Body  Model  /"equation. 


18 


5  -D 


■8 

o 

H 
IB 

u 

a 

'.0 

st 

3  -P 

c 

rl 

o 


s 


n    r 


9- 


r 
3 

=i 

1 

a 

8 

i     ? 

in 

>> 

hJ 

rl 

— r 

1 

8 

Figure  5.      Flexible  Body  Model  Controller  Block  Diagram 
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Figure  6.      Rigid  Body  Model  Controller 
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B.     OBSERVER  DESIGN 

Referring  back  to  equation  (4.6),  this  external  feedback  linearization  series  requires 
the  values  of  the  second  and  third  derivatives.  These  values  are  not  measurable  or 
available  from  the  plant. 

Often  it  is  not  possible  to  achieve  acceptable  performance  using  only  those  state 
variables  that  can  be  measured.  If  the  system  is  observable,  it  is  possible  to  estimate 
those  state  variables  that  are  not  directly  accessible  to  measurements  using  measuring 
data  from  those  that  are  measurable. 

State  variable  estimates  may  in  some  circumstances  be  even  preferable  to  direct 
measurements,  because  the  errors  produced  by  the  instruments  that  provide  the  meas- 
urements may  be  larger  than  errors  in  estimating  these  variables.   [Ref.  9:  p. 259] 

A  dynamic  system  whose  variables  are  known  can  be  estimated  with  the  use  of  an 
observer.  Luenberger  [Ref.  9:  pp.  260-216]  showed,  that  for  any  observable  linear  sys- 
tem, an  observer  can  be  designed  having  the  property  that  the  estimation  error  (the  dif- 
ference between  the  state  variables  of  the  actual  system  and  the  variables  of  the 
observer)  can  be  made  to  go  to  zero  as  fast  as  one  wants. 

A  state  observer  is  designed  to  estimate  the  values  of  6  and  6.  The  observer  is 
shown  in  Figure  8  and  in  Figure  9. 

A  mathematical  derivation  of  the  observer  used  in  this  research  is  presented  in  Ap- 
pendix D. 
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Figure  8.      Observer  Super  Block  Diagram 
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V.     EVALUATIONS 

After  designing  the  flexible-body  controller  and  reviewing  the  special  case  of  the 
rigid-body  controller,  a  comparison  will  be  conducted  between  the  two  controllers.  The 
comparison  will  be  focused  on  responding  speed,  payload  capacity  and  torque  require- 
ment. The  first  set  of  comparisons  will  be  between  the  two  methods  of  feedback  for 
rigid-body  control  (arm  feedback  and  motor  feedback).  The  second  set  of  comparisons 
will  be  between  the  rigid-body  control  (using  the  best  method  of  feedback)  and  flexible- 
body  control. 

A.     RIGID-BODY  CONTROL 

Simulations  were  conducted  for  the  special  case  of  the  Rigid-Body  Controller  in  or- 
der to  investigate  its  performance  characteristics.  The  controller  was  used  to  control  a 
plant  with  joint  flexibility.  The  parameters  used  in  the  simulation  were  from  the  third 
joint  of  the  PUMA  560  Robot  arm. 


ma  = 

4.8  kg 

h  = 

0.086  kg  -  m2 

-*  m 

0.83  kg  -  m2 

k  = 

11650    N~™ 

raa 

Gr  = 

53.69 

la 
2 

0.007  meter 

L/,  = 

0.439  meter 

MD  = 

2.5  kg 

For  the  Rigid-Body  case,  there  are  two  methods  of  feedback,  namely,  feedback  from 
the  tip  (arm)  position  and  feedback  from  the  motor  position.     To  demonstrate  and 
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evaluate  the  rigid-body  controller,  both  methods  of  feedback  will  be  investigated.  The 
servo  input  speeds  used  were  co„  =  1  and  co„  =  4.    The  following  three  outputs  will  be 

shown  for  each  method  and  speed: 

1.  Arm  position 

2.  Torque  requirements 

3.  Small  motion  differences 

Note,  on  the  graph  of  small  motion  (the  difference  between  the  arm  position  and  the 
motor  position),  the  major  line  is  the  servo  control  mode  which  is  the  result  of  the  entire 
system  movement.  The  second  part  is  the  mechanical  vibration  superimposed  onto  the 
servo  mode. 

1.  Rigid  Body  with  w„  =    1 

The  graphs  for  arm  feedback  are  shown  in  Figure  10,  Figure  11,  and  in 
Figure  12.  The  graphs  for  the  motor  feedback  are  shown  in  Figure  13,  Figure  14,  and 
in  Figure  15. 

As  shown  in  Figure  10,  an  unacceptable  long  settling  time  occurred  for  arm 
feedback.  The  cycle  time  is  longer  also  for  the  arm  feedback  case.  In  the  motor  feed- 
back case,  the  arm  settles  at  the  desired  position  of  5  radians  after  7.4  seconds.  Looking 
at  Figure  12,  and  Figure  15,  the  servo  control  mode  amplitude  difference  is  similar  be- 
tween the  two  cases  but  the  mechanical  vibration  (spikes)  is  more  pronounced  for  the 
arm  feedback  case.  Looking  at  Figure  1 1  and  Figure  14,  the  torque  is  32  times  lower 
for  arm  feedback  than  for  motor  feedback.  The  key  point  here  is  the  motor  feedback 
provides  overall  superior  performances  but  at  an  high  torque  requirement. 

2.  Rigid  Body  >vith  tu„  =    4 

The  servo  input  speed  was  increased  to  cjn  =  4  to  further  study  the  effects  of 
increased  speed  on  performance.   The  graphs  for  arm  feedback  are  shown  in  Figure  16, 


26 


:                 :              \ 

\ 

\ 

i 

) 

/ 

- 

y 

- 

>..^ef. 

- 

>^'"[ 

- 

/ 

y 

y 

/ 

V 

- 

\ 

\ 

- 

W*^w^^ 

- 

•             ~~--. 

-^ 

- 

1   1   1  1 

i  i    i   i  i 

i   i    i    i   I 

lilt 

i    i    i   i    i   i    i    i   i 

iiii 

1_J  J.  1 

\- 

III! 

LO 


—     |t  1 


li.l 

-t 

o 

II 

-1 

to 

r- 

h 

if) 

KJ 

■•-•' 

II 

n 

■+ ' 

th 

o  -\ 

-."'      '  ' 

'    !  C 


UJ       „ 

r-i    •.. 


O      t" 


in 


-    m 


D 


L('l 


Ll_ 


(suDipDj)      v    d;s»mx 
Figure   10.      Rigid  Body  Model  Arm  feedBack  (0,) 


27 


/ 


/ 


r 


J I I I I I I 1 I 1 L_l i       i 


) 


N  - 

: 


i  i 
i.'. ) 


-r 


L  J 


I!) 

i' I 


r   i 
("\ 


M.  I 


(0 

o 


■—••    r  i 

TJ 

g  "ll 

i  >  LI 
'1'  > 
(0 

|1 


in 


j i i l i i i I i i i i  o 


F 
L 

r  i 


CD 


no 


C£> 


CJ 


c-J 


iO 


(j^l  ?  iu  —  u  o  }  M9  li  )       ?n  bjoj. 


Figure   11.      Rigid  Body  Model  Arm  feedBack  (torque) 
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Figure   12.      Rigid  Body  Model  Arm  feedBack  (small  motion) 
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Figure   13.      Rigid  Body  Model  Motor  feedback  (0„) 
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Figure   14.      Rigid  Body  Model  Motor  feedback  (torque) 
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Figure   15.      Rigid  Body  Model  Motor  feedBack  (small  motion) 
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Figure  17,  and  Figure  18.    The  graphs  for  the  motor  feedback  are  shown  in  Figure  19, 
Figure  20,  Figure  21,  and  in  Figure  22. 

As  shown  in  Figure  16,  the  systems  response  time  has  increased,  but  after  40 
seconds  it  still  has  not  settled  out.  The  motor  feedback  settling  time  has  decreased  to 
1.9  seconds  (Figure  19).  Another  area  to  look  at  is  the  increased  in  the  level  of  small 
motion  (Figure  21)  and  (Figure  18).  The  mechanical  vibration  has  increased  for  both 
cases  but  the  level  is  still  less  for  the  motor  feedback  configuration.  The  torque  re- 
quirements for  motor  feedback  case  (Figure  20)  has  increased  by  a  factor  of  14. 

Appendix  E  presents  additional  simulation  runs  for  the  motor  feedback  config- 
uration. In  each  situation  a  step  input  with  a  desired  final  position  of  6d  =  5  was  used 
unless  otherwise  noted. 

Although  the  controller  was  designed  via  pole  placement  using  coefficients 
based  on  ITAE  performance  criteria,  in  the  comparison  between  the  two  rigid  body 
cases,  the  motor  feedback  case  obviously  demonstrated  the  best  performance  character- 
istics based  on  rise  time,  settling  time,  servo  control  mode  amplitude  difference,  me- 
chanical vibration  and  system  respond  time.  The  only  weakness  noted  is  in  the  area  of 
torque  requirements.  The  levels  for  the  motor  feedback  configuration  far  exceeded  the 
requirements  for  the  arm  feedback  case  (  by  32  times  for  <x>n  =  1  and  46  times  for  o>„  = 
4).   The  results  of  the  rigid  body  comparisons  are  listed  in  Table  1  on  page  41. 
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Figure   16.      Rigid  Body  Model  Ann  feedBack  (0,) 
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Figure  17.      Rigid  Body  Model  Arm  feedBack  (torque) 
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Figure   18.      Rigid  Body  Model  Arm  feedBack  (small  motion) 
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Figure  19.      Rigid  Body  Model  Motor  feed  back  (0J 
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Figure  20.      Rigid  Body  Model  Motor  feedBack  (torque) 
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Figure  21.      Rigid  Body  Model  Motor  feedBack  (small  motion) 
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Figure  22.      Rigid  Body  Model  Motor  feedBack.  (small  motion) 
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Table   1.     RIGID  BODY  MODEL  COMPARISON 


ARM  FEEDBACK 

MOTOR  FEEDBACK 

wn=  1 

C  =     o 

>vn  =  4 

C  =      0 

wn=  1 

C  =      0 

>\n  =  4 

C  =      0 

Rise  Time  (seconds) 

11.8 

3.0 

3.4 

0.8 

Settling  Time  (seconds) 

* 

* 

7.4 

1.9 

Maximum  Torque  (N-m) 

7.8 

76.0 

248.0 

3500.0 

Servo  Control  Mode  Ampli- 
tude Absolute  difference 
(radians) 

0.0001 

0.0002 

0.0003 

0.0004 

Mechanical  Vibration  (major 

peak  to  peak  average) 

(radians) 

0.008 

0.018 

0.0010 

0.0019 

Slope  (Speed)  (rad  s) 

0.46 

1.66 

1.47 

6.67 

*  Note  the  graph  had  not  settled  out  by  the  end  of  the  simulation  run. 

While  the  motor  feedback  case  seems  promising,  there  still  is  a  need  for  im- 
provements in  the  areas  of: 

1.  Lower  Torque  Requirements 

2.  Less  Mechanical  Vibrations 

3.  Lower  Servo  Mode  Small  Motion  Differences 

4.  Less  Mechanical  Electric  wear  on  actuator 

Therefore  the  flexible-body  control  will  be  compared  against  the  rigid-body 
control  using  motor  feedback  to  determine  if  there  is  an  improvement  in  performance 
characteristics.  Due  to  the  fact  the  Flexible-Body  is  a  fourth  order  controller,  the  servo 
speed  input  will  be  run  slightly  higher  in  order  to  make  realistic  comparisons.  A  point 
to  point  and  trajectory  tracking  control  scheme  were  used.  Added  mass  was  analyzed 
in  the  simulations  also. 
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B.     FLEXIBLE-BODY  CONTROLLER 
1.     Point  to  Point  Control  -  No  Load 

The  graphs  for  motor  feedback  are  shown  in  Figure  13,  Figure  14,  and 
Figure  15.  The  graphs  for  the  flexible  body  controller  are  shown  in  Figure  23, 
Figure  24,  and  Figure  25. 

Reviewing  the  flexible-body  graphs  and  the  rigid-body  graphs,  the  flexible-body 
controller  provides  improvements  in  all  characteristic  areas  with  a  decrease  in  required 
torque.  All  this  occurs  with  the  flexible-body  controller  moving  at  a  faster  servo  input 
speed.  Other  than  one  large  spike  at  0.8  seconds,  the  flexible-body  model  exhibited  6 
times  less  mechanical  vibration.  The  servo  control  mode  amplitude  difference  was  sim- 
ilar between  the  two  cases.  With  an  increase  in  input  servo  speed,  the  servo  control 
mode  amplitude  difference  and  mechanical  vibrations  increased  as  expected. 

The  second  simulation  analyzed  the  effect  of  increased  servo  input  speed  on  the 
performance  characteristics  of  the  two  controllers.  As  seen  in  Table  2  on  page  46,  the 
flexible-body  controller  still  requires  less  torque,  generates  less  mechanical  vibration  and 
has  a  steeper  slope  than  the  rigid-body  controller.  The  steeper  slope  equates  to  a  more 
responsive  system.  The  servo  control  mode  amplitude  difference  was  also  lower  than  the 
rigid-body  model.   The  graphs  of  these  simulation  runs  are  in  Appendix  E. 
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Figure  23.      Flexible  Body  Model  (0.) 
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Figure  24.       Flexible  Body  Model  (torque) 
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Figure  25.      Flexible  Body  Model  (small  motion) 
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Table  2.     FLEXIBLE  BODY  VS  RIGID  BODY  MODEL  -  NO  LOAD 


Flexible  Body  Model 

Rigid  Body  Model 

wn  =  2 
C  =     o 

wn  =  4 

C  =     o 

wn=  1 

C  =    o 

wn  =  3 
C  =      0 

Rise  Time  (seconds) 

2.2 

0.8 

3.4 

1.0 

Settling  Time  (seconds) 

3.2 

2.1 

7.4 

2.5 

Maximum  Torque  (N-m) 

222.0 

870.0 

248.0 

1910.0 

Servo  Control  Mode  Ampli- 
tude Absolute  difference 
(radians) 

0.0003 

0.0003 

0.0003 

0.0003 

Mechanical  Vibration  (major 

peak  to  peak  average) 

(radians) 

0.0005 

0.0005 

0.0010 

0.0015 

Slope  (Speed)  (rad/s) 

2.27 

6.25 

1.47 

5.00 

2.     Load  and  Speed  Considerations 

Since  the  main  purpose  for  studying  a  controller  is  to  determine  if  it  can  perform 
its  designed  tasks,  a  comparison  of  two  different  loads  (1.36  kg  and  2.5  kg)  and  various 
speeds  were  investigated  in  order  to  study  the  difference  in  capabilities  between  the  two 
methods  or  control.  Again  since  the  flexible-body  is  a  fourth  order  controller,  the  servo 
input  speed  was  ran  slightly  higher  in  order  to  allow  more  realistic  comparisons.  The 
comparable  speeds  used  were  <y„  =  1  and  co„  =  3  for  rigid-body  control  and  co„  =  2 
and  o>n  =  4  for  flexible-body  control.  The  graphs  of  the  robot  arm  positions  can  be 
seen  in  Figure  26  through  Figure  33. 

As  can  be  seen  in  Table  3  on  page  55  and  Table  4  on  page  56,  as  the  load  in- 
creases, the  torque  requirements  has  increase  by  a  factor  of  8  (from  312  N-m  to  2505 
N-m  for  1.36  kg  and  370  N-m  to  2900  N-m  for  2.5  kg)  for  the  rigid-body  model  but  the 
flexible-body  model  experienced  only  an  increase  of  a  factor  of  3.8  (from  231  N-m  to  900 
N-m  for  1.36  kg  and  238  N-m  to  900  N-m  for  2.5  kg).  The  servo  control  mode  amplitude 
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Figure  26.      Flexible  Body  Model  (0,) 
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Figure  27.      Flexible  Body  Model  (0.) 
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Figure  28.      Rigid  Body  Model  (0,) 
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Figure  29.      Rigid  Body  Model  (0.) 
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Figure  30.      Flexible  Body  Model  (0,) 
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Figure  31.      Flexible  Body  Model  (0.) 
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Figure  32.      Rigid  Body  Model  (0.) 
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Figure  33.      Rigid  Body  Model  (0.) 
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difference  has  increase  by  2.5  for  the  rigid  body  model  but  only  by  1.8  for  the  flexible- 
body  controller  for  the  same  load  change.  The  rigid-body  controller  experienced  more 
mechanical  vibration  as  can  be  seen  in  Table  3  on  page  55  and  Table  4  on  page  56. 
Also  the  rise  time  has  slowed  down  for  the  rigid-body  controller  as  the  load  increases. 
As  the  servo  speed  input  increases,  the  rigid-body  control  experience  higher  torque  re- 
quirement changes,  higher  level  of  mechanical  vibration  and  larger  servo  control  mode 
amplitude  differences.  The  flexible-body  control  requires  less  torque,  experience  less 
mechanical  vibration  and  smaller  servo  control  mode  amplitude  for  a  comparable  speed 
increase.  The  rise  time  is  quicker  for  flexible-body  control  for  a  comparable  increase  in 
servo  input  speed. 

Table  3.     FLEXIBLE  BODY  VS  RIGID  BODY  MODEL  -  1.36  KG 


Flexible  Body  Model 

Rigid  Body  Model 

wn  =  2 
I  = 
0.01 

wn  =  4 

C  = 
0.01 

wn=  1 

{  = 
0.01 

wn  =  3 

c  = 

0.01 

Rise  Time  (seconds) 

2.3 

1.3 

3.7 

1.8 

Settling  Time  (seconds) 

5.5 

2.7 

5.0 

3.0 

Maximum  Torque  (N-m) 

231.0 

900.0 

312.0 

2505.0 

Servo  Control  Mode  Ampli- 
tude Absolute  difference 
(radians) 

0.0037 

0.0068 

0.0025 

0.0062 

Mechanical  Vibration  (major 

peak  to  peak  average) 

(radians) 

0.0015 

0.0015 

0.0015 

0.0045 

Slope  (Speed)  (rad's) 

2.17 

3.85 

1.35 

2.78 
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Table  4.     FLEXIBLE  BODY  VS  RIGID  BODY  MODEL  -  2.5  KG 


Flexible  Body  Model 

Rigid  Body  Model 

wn=  2 

C  = 
0.01 

wn  =  4 

c  - 

0.01 

wn=  1 

C  - 
0.01 

\vn  =  3 

c  - 

0.01 

Rise  Time  (seconds) 

2.3 

1.1 

4.0 

1.5 

Settling  Time  (seconds) 

5.5 

2.8 

6.0 

4.0 

Maximum  Torque  (N-m) 

238.0 

900.0 

370.0 

2900.0 

Servo  Control  Mode  Ampli- 
tude Absolute  difference 
(radians) 

0.0050 

0.0090 

0.0034 

0.0080 

Mechanical  Vibration  (major 

peak  to  peak  average) 

(radians) 

0.0020 

0.0025 

0.0028 

0.0070 

Slope  (Speed)  (rad/s) 

2.20 

4.54 

1.25 

3.33 

The  mass  increase  had  little  effect  on  the  performance  of  the  flexible-body  con- 
troller but  the  rigid-body  controller  stability  has  decrease.  The  robot  arm  position 
graphs  for  the  rigid-body  case  exhibit  little  or  no  overshoot  as  required  by  the  ITAE 
criteria  used  to  design  the  controller.  The  mechanical  vibration  of  the  rigid-body  control 
system  has  increased  also  for  both  a  speed  increase  as  well  as  a  mass  increase. 

From  the  stand  point  of  desirability,  the  flexible-body  controller  moves  the 
added  mass  faster  with  less  vibration  or  system  wear,  and  with  less  torque.  The 
flexible-body  controller  still  continues  to  demonstrate  superior  performance  character- 
istics even  with  a  load  placed  at  the  tip  position  and  a  comparable  speed  increase. 

The  torque  and  small  motion  graphs  can  be  viewed  in  Appendix  E. 

As  shown  by  the  graphs,  the  flexible-body  controller  again  outperformed  the 
rigid-body  controller.  The  flexible-body  controller  requires  less  torque  to  move  the 
added  mass  and  does  it  at  a  faster  speed.     The  mechanical  vibration  is  less  for  the 
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Flexible-Body  case  even  though  the  servo  control  mode  difference  is  similar  between  the 
two  controllers. 

3.    Trajectory  Motion 

The  next  simulation  involved  a  trajectory  tracking  with  and  without  an  added 
mass.  The  trajectory  tracking  was  a  combination  of  a  steady  ramp  input  with  a  leveling 
ofTat  4  seconds  and  a  desired  arm  position  of  five  radians.  Next,  after  holding  the  input 
at  a  constant  value  in  order  to  maintain  an  arm  position  of  five  radians,  a  negative  ramp 
input  at  10.5  seconds  was  used  to  bring  the  arm  back  to  its  starting  position  at  approx- 
imately 16  seconds.  The  results  of  the  simulation  are  listed  in  Table  5.  The  graphs  of 
the  robot  arm  motion  can  be  seen  in  Figure  34  through  Figure  37.  The  other  graphs 
are  in  Appendix  E. 

Table  5.     FLEXIBLE  BODY  VS  RIGID  BODY  MODEL  -  TRAJECTORY 


Flexible  Body  Model 

Rigid  Body  Model 

wn  =  2 

r     

0 

no  mass 

wn  =  2 

C  - 
0 
added  mass 
2.5  kg 

wn=  1 

C  = 
0 
no  mass 

wn  =  1 

c  = 

0 

added  mass 

2.5  kg 

Desired  Rise  Time  (seconds) 

4.0 

4.0 

4.0 

4.0 

Settling  Time  (seconds)  * 

6.5 

6.3 

7.5 

7.0 

Maximum  Torque  (N-m) 

92.0 

110.0 

98.00 

140.0 

Servo  Control  Mode  Ampli- 
tude Absolute  difference 
(radians) 

0.00029 

0.0026 

0.0004 

0.0080 

Mechanical  Vibration  (major 
peak  to  peak  average) 

(radians) 

0.00020 

0.00060 

0.0010 

0.0050 

Desired  Slope  (Speed)  (rad  s) 

1.25 

1.25 

1.25 

1.25 

*  For  the  level  portion  of  the  trajectory  between  the  two  ramps  only 

As  seen  in  Figure  34  through  Figure  37,  there  is  a  more  pronouned  overshoot 
than  found  on  the  point  to  point  control.   This  is  due  to  the  momentum  left  over  in  the 
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Figure  34.      Flexible  Body  Model  Trajectory  (6.) 
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Figure  35.      Flexible  Body  Model  Trajectory  (0.) 
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Figure  36.      Rigid  Body  Model  Trajectory  (6,) 
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Figure  37.      Rigid  Body  Model  Trajectory'  (9.) 
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system  as  it  reaches  the  desired  position.  It  overshoots  the  position  and  gradually  settles 
down  to  the  final  position.  Due  to  the  fact  the  controller  gradually  rises  the  arm  to  its 
desired  position  instead  of  a  sudden  jump  similar  to  point  to  point  control,  less  torque 
is  required  to  perform  the  same  movement.  As  a  result  less  mechanical  vibration  is  de- 
tected and  the  servo  control  mode  amplitude  is  less.  The  desired  trajectory  was  designed 
to  lower  the  speed  response  to  the  desired  trajectory  at  the  saving  of  wear  and  tear  on 
the  equipment.  With  less  torque  required,  this  tracking  method  would  consume  less 
energy.  The  flexible-body  controller  still  was  able  to  outperform  the  rigid-body  con- 
troller. With  an  increase  in  load,  the  flexible-body  control  servo  control  mode  amplitude 
was  less  than  the  rigid-body  control  experiencing  the  same  load  increases.  Also  the 
mechanical  vibration  and  the  torque  requirements  were  less  for  the  flexible-body  control. 
But  even  still  the  trajectory  tracking  allows  larger  masses  to  be  handled  at  a  lower  re- 
quired torque  than  do  the  point  to  point  control  method.  For  comparable  speed  in- 
creases, similar  results  were  obtained.  The  level  of  mechanical  vibration  and  the  servo 
control  mode  amplitude  were  greater  for  the  rigid-body  control.  The  torque  require- 
ments were  also  greater  for  the  rigid-body  control.  The  the  relative  stability  were  similar 
for  both  the  flexible-body  and  rigid-body  control. 

Overall  observation  is  the  trajectory  tracking  required  less  torque  to  move  a 
mass  than  the  point  to  point  control  required  to  move  the  arm  with  no  mass  attached. 
Also  the  loaded  condition  reached  a  relative  stability  condition  faster  than  the  unloaded 
case.  An  increase  in  load  from  0  kg  to  2.5  kg  and  comparable  increases  in  servo  input 
speeds  resulted  in  an  increase  in  the  mechanical  vibration  and  servo  control  mode  am- 
plitude for  both  controllers,  with  the  rigid-body  controller  level  of  vibration  being 
slightly  higher  than  the  flexible-body  controller.  But  the  overall  level  of  mechanical  vi- 
bration and  servo  control  mode  amplitude  difference  for  the  trajectory  tracking  method 
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is  less  than  the  vibration  level  and  servo  control  mode  amplitude  difference  for  the  point 
to  point  control  method. 

C.     TORQUE  SATURATION  CONSIDERATIONS 

The  simulation  analysis  up  to  this  point  has  not  considered  an  input  torque  limita- 
tion on  the  motor  for  the  actuator.  Since  the  PUMA  Robot  arm  is  used  as  the  model 
for  this  research  work,  the  limitation  of  the  model  should  be  included  in  the  analysis  of 
the  flexible  body  controller.  The  PUMA  Robot  arm  was  designed  as  a  rigid  body  device 
which  restricts  any  flexibility  in  its  operation. 

A  saturation  device  was  included  in  the  design  in  order  to  study  the  performance 
characteristics  of  the  controller  controlling  the  PUMA  Robot  arm.  A  value  of  49.2 
newton-meters  was  used  as  the  torque  saturation  point  (49.2  newton-meters  is  the 
torque  limit  of  the  third  joint  motor  on  the  PUMA  arm). 

First  the  performance  of  the  Rigid  Body  case  will  be  looked  at  and  finally  the  Flex- 
ible Body  case  will  be  reviewed. 

1.     Rigid  Body  Saturation  Case 

For  the  graphs  of  the  Rigid  Body  case  with  saturation  included,  see  Figure  38 
for  point  to  point  control  and  Figure  39  and  Figure  40  for  trajectory  control.  For  the 
Rigid  Body  case,  when  the  the  torque  value  exceeded  the  preset  limit  of  49.2  newton- 
meters,  the  curve  flattened  out  until  the  torque  decreased  below  the  preset  limit.  The 
servo  control  mode  amplitude  and  the  mechanical  vibration  results  are  similar  to  the 
cases  without  torque  limitation  included.  The  rise  time  for  the  saturation  case  is  slower 
and  the  settling  time  is  longer.  For  a  summary  of  the  rigid  body  simulations  see 
Table  6  on  page  67. 


63 


tO 


> 


Csl 


o 


o 

II 

to 
to 
o 

E 

8  E 


CO   .w 


O 


"D 

D 

CD 

■g 


j 1 1 1 I 1 1 1 1 1 1 1 1 1 I 1 1 1 1 1 1 '     '     '     1     '     '     '     '    1   O 

ID  tO  "*■  lO  CM  r-  O 


(SUDIPDJ)        V     DPMI 


Figure  38.      Rigid  Body  Model  (saturation) 
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Figure  39.      Rigid  Body  Model  (saturation) 
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Figure  40.      Rigid  Body  Model  (saturation) 
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Table  6.     RIGID  BODY  TORQUE  LIMITATION  RESULTS 


Point  to  Point 
Tracking  Con- 
trol 

Trajectory 
Tracking  Con- 
trol 

Trajectory 
Tracking  Con- 
trol 

wn=  1 

c  = 

0 
no  load 

wn=  1 

c  - 

0 
no  load 

wn=  1 

c  = 

0 
mass  = 
2.5  kg 

Maximum  Torque  (N-m) 

49.2 

49.2 

49.2 

Servo  Control  Mode  Ampli- 
tude Absolute  difference 
(radians) 

0.0003 

0.0004 

0.003 

Mechanical  Vibration  (major 

peak  to  peak  average) 

(radians) 

0.0055 

0.0024 

0.0070 

Maximum  Overshoot 
(radians) 

5.2 

5.7 

5.6 

2.     Flexible  Body  Saturation  Case 

For  graphs  of  the  flexible  body  case  with  saturation  included,  see  Figure  41  and 
Figure  42  for  point  to  point  control  and  Figure  43  for  trajectory  control. 

For  the  point  to  point  control  with  input  servo  speed  of  o>n  =  2,  the  torque 
curve  had  a  secondary  frequency  mode  superimposed  on  it  during  the  time  input  torque 
exceeded  the  imposed  limit.  This  was  present  only  at  a>n  greater  than  one.  Overshoot 
of  the  final  desired  position  was  higher  for  the  saturation  cases.  This  was  due  to  the 
momentum  which  was  still  present  in  the  system  after  the  torque  limitation  was  reached. 
The  servo  control  mode  amplitude  differences  are  similar  to  the  non  saturation  cases  but 
the  mechanical  vibration  was  higher  for  the  torque  saturation  cases.  Using  the  trajec- 
tory tracking  method  with  added  mass  (Figure  43),  the  controller  was  still  able  to  move 
the  mass  to  the  desired  arm  position  but  at  a  reduced  level  of  performance  when  com- 
pared to  the  case  where  motor  torque  limitations  are  not  considered. 
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Figure  41.      Flexible  Body  Model  (saturation) 
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Figure  42.      Flexible  Body  Model  (saturation) 
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Figure  43.      Flexible  Body  Model  (saturation) 
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The  Flexible-Body  controller  was  still  able  to  control  the  plant  at  a  greater  per- 
formance level  than  the  Rigid-Body  controller  in  the  areas  of  less  mechanical  vibration, 
smaller  servo  mode  amplitude  differences  and  quicker  settling  times,  but  its  performance 
was  degraded  due  to  the  limitation  of  the  torque  motor  input.  For  a  summary  of  flexible 
body  model  simulations  see  Table  7. 

Table  7.     FLEXIBLE  BODY  TORQUE  LIMITATION  RESULTS 


Point  to  Point 
Tracking  Con- 
trol 

Trajectory 
Tracking  Con- 
trol 

Trajectory 
Tracking  Con- 
trol 

wn  =  2 

c  = 

0 
no  load 

wn  =  2 

C  = 
0 
no  load 

wn=  2 

c  = 

0 
mass  = 
2.5  kg 

Maximum  Torque  (N-m) 

49.2 

49.2 

49.2 

Servo  Control  Mode  Ampli- 
tude Absolute  difference 
(radians) 

0.0003 

0.0003 

0.0034 

Mechanical  Vibration  (major 
peak  to  peak  average) 

(radians) 

0.0005 

0.0008 

0.0020 

Maximum  Overshoot 
(radians) 

5.8 

6.0 

6.02 

D.     DISCUSSION 

1.     Rigid  Body  Results 

The  performance  of  the  motor  feedback  method  of  control  remains  superior  to 
the  arm  feedback  method  for  all  servo  bandwidths.  With  its  long  settling  time,  the  arm 
feedback  is  unacceptable  as  a  method  of  control.  This  poor  performance  is  due  to  the 
fact  the  sensors  and  actuators  used  for  control  are  separated  by  the  flexible  structure  of 
the  transmission  line  and  gears.  The  flexibility  of  the  system  introduces  noise  in  the 
feedback  loop  which  in  turn  produces  erroneous  or  inaccurate  signals  to  be  received  by 
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the  controller.  The  motor  feedback,  on  the  other  hand,  is  not  faced  with  this  predica- 
ment. Its  sensor  and  actuator  are  located  together  and  is  not  faced  with  this  unwanted 
disturbance  or  noise. 

Another  key  point  are  the  two  parts  of  the  small  motion  (the  difference  between 
the  arm  position  and  the  motor  position)  graph.  The  major  line  is  the  servo  control 
mode  which  is  the  result  of  the  entire  system  movement.  The  second  part  is  the  me- 
chanical vibration  superimposed  onto  the  servo  mode.  As  the  servo  input  frequency  is 
increased,  the  servo  mode  motion  increased  with  a  slight  increase  in  mechanical  vi- 
bration. This  is  due  to  the  fact  the  servo  frequency  co„  moves  towards  the  systems  na- 
tural frequency  u)0  When  damping  is  introduced,  the  mechanical  vibration  decreases 
slightly  while  the  servo  mode  increases.  With  the  addition  of  t  ,  the  system's  natural 
frequency  decreases  to  cod.  With  this  decrease  in  natural  frequency  which  relates  to  a 
movement  towards  the  servo  input  frequency,  the  excitation  of  the  system  increases  due 
to  this  closer  position  of  &)a  to  co„. 
2.     Flexible  Body  Results 

The  Flexible  Body  Model  has  demonstrated  improved  characteristics  in  each  of 
the  areas  which  were  measured.  One  superior  quality  was  the  ability  of  the  controller 
to  move  at  a  faster  rate  yet  use  less  torque  while  the  Rigid  Body  controller  required  more 
torque  while  moving  at  a  slower  speed.  This  means  the  Flexible  controller  has  the  ca- 
pability to  control  greater  payloads,  provide  more  accuracy  and  could  possibly  consume 
less  energy.  The  results  of  the  simulations  are  listed  in  the  tables  on  the  pages  to  follow. 
The  results  of  the  Rigid  Body  Model  comparison  is  listed  in  Table  1  on  page  41  below. 
To  see  the  Flexible  Body  Model  vs  Rigid  Body  Model  results  see  Table  2  on  page  46. 
To  review  the  effects  of  damping  on  the  Rigid  Body  and  Flexible  Body  Model  both  with 
input  speed  increases  and  added  mass  increases  see  Table  3  on  page  55  and  Table  4  on 
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page  56.  To  see  the  results  of  trajectory-  tracking  effects  on  the  Flexible  Body  Model  and 
Rigid  Body  Model  see  Table  5  on  page  57. 
3.     Saturation  Case  Results 

For  the  cases  where  torque  saturation  was  considered,  the  Flexible  Body  con- 
troller performance  characteristics  deteriorated  as  the  result  of  the  limitation  of  the  ri- 
gidity of  the  PUMA  Robot  arm.  The  level  of  mechanical  vibration  increased  and  the 
servo  mode  level  increased  also.  At  an  input  servo  speed  of  o)„  greater  than  one,  sec- 
ondary frequencies  of  the  servo  system  were  superimposed  on  the  torque  curves  where 
the  level  exceeded  the  preset  torque  limit  (since  the  Flexible  Body  controller  is  a  fourth 
order  equation,  is  has  an  additional  frequency  mode  which  is  not  present  in  the  Rigid 
Body  controller).  For  the  added  mass  case,  the  flexible  body  controller  was  still  able  to 
control  the  plant.  The  performance  characteristic  were  superior  to  the  Rigid  Body  con- 
troller in  the  areas  of  less  mechanical  vibration,  smaller  servo  control  mode  amplitude 
differences  and  quicker  settling  times.  However,  the  performance  of  the  controller  was 
still  degraded.  The  controller  needs  to  operate  with  a  plant  designed  with  flexibility. 
The  PUMA  plant  is  designed  to  be  a  rigid  plant  and  therefore  restricts  the  capability  of 
the  flexible  body  controller.  The  controller  stability  has  decreased  as  a  result  of  this  re- 
striction in  motor  torque.  The  results  of  saturation  effects  on  the  Rigid  Body  Model  can 
be  seen  in  Table  6  on  page  67  and  the  results  of  the  Flexible  Body  Mode  experiencing 
torque  limitation  can  be  reviewed  in  in  Table  7  on  page  71. 

In  Figure  44  is  the  Super  Block  diagram  of  the  entire  system  of  the  Flexible 
Body  Model.  In  Figure  45  is  displayed  the  Super  Block  diagram  of  the  Rigid  Body 
Model  system. 

Additional  simulations  were  run  at  various  input  speeds,  with  and  without 
damping.  These  runs  without  explanation  can  be  reviewed  in  Appendix  E.  The  graphs 
are  self  explanatory.   The  desired  final  position  of  5  radians  was  used  in  all  cases. 
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figure  44.      Flexible  Body  Model  Super  Block 
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Figure  45.      Rigid  Body  Model  Super  Block 
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VI.     CONCLUSIONS 

A.     INSIGHTS 

The  flexible-body  controller  performance  was  superior  to  the  rigid  body  controller. 

The  results  of  the  comparisons  between  the  two  controllers  are  summarized  as  follows: 

1.  With  an  increase  in  input  servo  speed,  the  rigid  body  had  a  higher  Mechanical  vi- 
bration level 

2.  The  flexible  body  model  required  less  torque  even  at  a  higher  input  speeds 

3.  The  flexible  body  model  proved  to  be  a  responsive  robust  system  over  the  range 

of  speeds  and  conditions  tested 

4.  The  torque  requirement  for  the  added  mass  case  was  less  for  the  flexible-body 
controller 

5.  The  flexible  body  model  performance  characteristics  were  superior  to  a  rigid  body 
for  both  an  increase  in  load  and  speed 

6.  A  ramp  input  requires  a  lower  torque  requirement  with  no  increase  in  servo  mode 

or  mechanical  vibration 

7.  The  flexible-body  controller  using  a  ramp  trajectory  was  able  to  handle  a  greater 
load  with  an  improvement  in  all  performance  characteristics  except  rise  time  which 
increased  slightly 

It  appears  the  results  obtained  points  towards  selecting  the  flexible  body  controller. 
However,  since  the  results  are  based  on  simulations,  more  comparisons  should  be  con- 
ducted at  more  speeds  and  a  variety  of  loads.  This  research  considered  the  the  flexibility 
in  the  gear  coupling  and  neglected  gear  backlash. 

The  case  of  the  torque  limitation  did  point  out  some  of  the  limitations  of  the 
flexible-body  controller.  The  performance  characteristics  deteriorated  as  the  result  of  the 
limitation  of  available  input  servo  torque.  The  level  of  mechanical  vibration  increased 
and  the  servo  mode  level  increased  also.  At  input  servo  speeds  greater  than  <yn  =  1, 
secondary  frequencies  of  the  servo  system  were  superimposed  on  the  torque  curve  where 
the  torque  required  exceeded  the  preset  level.    Results  in  the  simulations  indicate  that 
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actuator  saturation  may  be  the  only  significant  nonlinearity  in  the  robot  motion  design 
problem. 

B.     RECOMMENDATIONS 

The  following  recommendations  are  submitted: 

1.  Continue  further  study  of  the  Flexible  Body  Model  under  varies  simulated  condi- 
tions and  load. 

2.  Build  a  Flexible  Body  Controller  and  test  it  on  the  PUMA  Robot. 

3.  Extend  the  present  study  of  the  Flexible  Manipulator  to  include  more  than  one 
joint. 

Additional  suggestions  are: 

1.  The  flexible  body  controller  be  used  at  input  speeds  which  do  not  exceed  the  satu- 
ration level  or  the  actuator. 

2.  The  flexible  body  controller  be  tested  on  plants  which  were  design  to  be  flexible. 


77 


APPENDIX  A.     MATRIX* 

A.     MATRIX* 

MATRIX*  is  a  Computer  Aided  Engineering  software  package  for  modeling,  simu- 
lation, engineering  analysis,  control  design,  signal  processing,  and  system  identification. 

MATRIX*  ,  is  a  programmable,  matrix  solving  software  package  with  emphasis  on 
controls  applications.  Scalar  functions  as  well  as  complex,  large-scale  matrix  problems 
can  be  solved  using  the  state-of-the  art  matrix  analysis  functions  built  into  MATRIX*  . 
MATRIX*  can  be  used  to  solve  complex,  large-scale  matrix  problems  in  an  engineering 
discipline.  However,  it  is  bested  used  in  the  analysis  of  control  engineering  related 
problems.  MATRIX*  was  designed  to  have  a  complete  set  of  design  and  analysis  func- 
tions for  input/output  (classical)  control  and  state-space  (modern)  control."  [Ref.  10] 

Control  systems  are  concerned  with  the  control  of  specific  variables.  The  interre- 
lationship of  the  controlled  variables  to  the  controlling  variables  is  required.  This  re- 
lationship is  typically  represented  by  the  transfer  function  of  the  subsystem  relating  the 
input  and  output  variables.  Therefore,  the  transfer  function  is  an  important  relation  for 
control  engineering.  The  importance  of  the  cause  and  effect  relationship  of  the  transfer 
function  is  evidence  by  representing  the  relationship  of  the  system  by  use  of  diagrams 
called  block  diagrams. 

The  block  diagram  representation  of  a  system's  relationships  is  prevalent  in  control 
system  engineering.  Block  diagrams  consist  of  unidirectional,  operational  blocks  that 
represent  the  transfer  function  of  the  variables  of  interest.  Once  the  block  diagram  is 
developed,  a  transfer  function  relation  is  defined,  and  the  system  is  analyzed  using  the 
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transfer  function.  MATRIX*  has  a  feature  called  SYSTEMBLTLD2  which  solves  linear 
or  non-linear  control  problems  directly  from  block  diagrams. 

B.    SYSTEM_BUILD 

SYSTEM_BUILD  is  an  interactive,menu-driven  graphical  environment  for  building, 
modifying  computer  simulation  models.  Any  combination  of  linear,  non-linear, 
continuous-time  or  discrete-time  models  that  describe  a  system  can  be  constructed  from 
a  library  of  more  that  70  distinct  block  types.  Simulating  system  performance  under 
both  nominal  and  constrained  environments  is  easily  accomplished  with 
SYSTEM_BUILD.   [Ref.  11:  pp.  SB  P-l-SB  P-2] 

Systems  are  modeled  by  dividing  them  into  individual  components,  and  each  com- 
ponents is  described  by  a  specific  type  of  functional  block.  A  group  of  functional  blocks 
are  called  Super  Blocks,  and  Super  Blocks  can  be  nested  together  within  another  Super 
Block.  Once  a  system  is  modeled  in  SYSTEM_BUILD,  The  system  is  analyzed  in  the 
MATRIX*  interpreter.  Any  system  modeled  in  SYSTEM_BLTLD  can  be  simulated, 
linearized,  and  analyzed  through  the  use  integration  algorithms,  built  into  the 
MATRIX,  interpreter,  which  are  suitable  for  simulating  a  variety  of  systems. 
[Ref.  11:  pp.  SB  P-l] 


2  SYSTEM  BUILD  is  a  trademark  of  Integrated  Systems  Incorporated. 
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APPENDIX  B.     PUMA  560  ROBOT  DESCRIPTION 

The  Puma  560  Robot  is  an  industrial  robot  system  with  six  degrees  of  freedom.  It 
is  comprised  of  a  robot  arm  (Figure  46)  [Ref.  6:  p.  1-20],  a  controller,  software,  and 
other  peripherals.  It  is  designed  to  manipulate  nominal  end-effector  load  of  2.5  kilo- 
grams. With  a  positional  repeatability  of  0.1  milli-meters.  It  has  a  spherical  work  en- 
velope of  0.92  meters  (Figure  47)  [Ref.  6:  p.  2-2].  Its  drive  is  an  electric  DC  servomotor. 
The  maximum  tool  acceleration  is  1  G  with  a  maximum  tool  velocity  of  1.0  meter  per 
second  (with  maximum  load  within  the  primary  work  envelope).  The  maximum  static 
force  at  the  tool  is  58  newtons.  The  arm  assembly  is  driven  by  a  permanent-magnet  DC 
servomotor  driving  through  its  associated  gear  train.  The  motor  contains  an  incremental 
encoder  and  a  potentiometer  driven  through  a  116  to  1  gear  reduction.  The  motor  is 
housed  in  the  upper  arm.  The  gear  train  is  housed  in  the  elbow  end  of  the  upper  arm 
and  is  connected  to  the  motor  by  a  drive  shaft.  A  bevel  pinion  on  the  input  shaft  drives 
a  bevel  gear  on  one  end  of  an  idler  shaft.  A  spur  pinion  at  the  other  end  of  the  idler 
shaft  engages  a  bull  gear  fixed  to  the  forearm,  and  so  rotates  the  forearm  around  the 
elbow  axis.    [Ref.  6:  pp.  1-22-1-25] 

The  PUMA  560  Robot  is  controlled  by  a  closed-loop  control  system.  Incremental 
encoders  and  potentiometers  at  each  drive  motor  provide  the  positional  feedback  for  the 
control  system.  Each  of  the  joint  encoders  provides  a  resolution  of  approximately  0.005 
degree/bit  .  The  PUMA  560  robot  can  also  be  positioned  using  transformations. 
[Ref.   12] 
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Figure  46.      PUMA60  Robot  Arm 


81 


THIS  REGION  IS 
ATTAINABLE  BY 
ROBOT  IN  LEFTY 
CONFIGURATION 


0.864  m  (34.0  In.) 
MAX.  RADIUS  SWEPT 
BY  HAND    CENTER-LINE 
(0.020  m  RADIUS 
TO  TOOL  FLANGE) 


THIS  LINE 
GENERATE3 
WORKING  ENVELOPE 


aiSO  m  (6.0  In.) 
MIN.  RADIUS  3WEPT 
HAND  CENTER-LINE 


0.432  m  (17.0  In.) 
RADIUS 


Figure  47.      Robot  Arm  Operating  Envelope 
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APPENDIX  C.     ADDED  MASS  AND  DAMPING 

A.     ADDED  MASS  EQUATIONS 

For  added  mass,  the  J^  term  is  revised  to  include  the  additional  mass  which  is  placed 
at  the  arm  tip  position.   The  appropriate  term  is: 

MflLflgCOSfl,,  (C.l) 

which  is  added  to  Equations  (3.4)  and  (3.7).  The  following  term  MDL2D  is  added  to  the 
]A  term  which  results  in  a  new  term  JaT,  which  represents  the  moment  of  inertia  for  the 
link  (arm)  and  the  added  mass  (see  Figure  48). 

Now  performing  the  derivation  for  the  controller  as  presented  in  Chapter  Four  with 
the  additional  added  mass  terms,  the  revised  F  equation  (Equation  4.4)  will  be: 


r=  lm 


Gr  -  sin  6a  -    - sin  Bn  10, 


mag  MDglD  \^2 

+    ; )0„  cos  6, 


2k  k 

+  (magl  +  M^L^cosfl 


+  JATOa 


(C.l) 


Figure  49  illustrates  the  block  diagram  elements  which  are  added  to  the  F  equation 
inorder  to  revise  the  Flexible  Body  Model  overall  system  equations.  By  setting  mass 
equal  to  zero  (for  no  added  mass)  these  terms  do  not  effect  the  simulation  of  the  plant. 
See  Figure  4  for  a  block  diagram  of  the  F  equation. 

For  the  special  case  of  the  Rigid  Body  Model,  the  F  equation  (Equation  4.9)  is 
modified  as  shown: 


F-  mag—cos6  +  MDgLDcos9  (C.3) 
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Figure  48.      J,T  Added  Mass  Terms 
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Figure  49.      Flexible  Body  Model  Added  Mass  Block 
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See  Figure  7  for  a  block  diagram  of  the  Rigid  Body  Model  F  equation  with  the  place- 
ments of  the  added  mass  terms. 

B.     DAMPING 

Damping  is  considered  in  both  the  Flexible  Body  Model  and  the  Rigid  Body  Model. 
The  following  term  is  added  to  equations  3.4,  3.5,  and  3.7 


c  '  2V UTTTfiJ  (C4) 


Damping    =    C(<5) 

(C5) 


in  order  to  observe  the  performance  characteristics  of  the  two  models  with  and  without 
damping.    See  Figure  50  for  a  block  diagram  of  the  damping  term. 
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Figure  50.      Damping  Block.  Diagram 


87 


APPENDIX  D.  STATE  OBSERVER  DERIVATION 

A.  BACKGROUND 

A  dynamic  system  can  be  represented  in  state-space  form  by  the  following  equation: 

x  =  Ajc  +  bu  {DA) 

A  control  law  of 


u  =    —  Gx 

(D.2) 
x  =  (A  -  bG)x 


can  be  assumed  if  'x'  is  accessible  for  measurements.  But  instead  of  being  able  to 
measure  the  state  'x',  one  can  only  measure 

y   -    Cx  (D.3) 

where  the  dimension  m  of  the  observation  vector  y  is  less  than  the  dimension  of  x 
[Ref.  9:  p.260]. 

Errors  inevitably  will  be  present  in  the  measurement  of  y(t).  These  errors  mean  only 
an  estimate  for  \(t)  of  x(t)  can  be  made  and  never  x(t)  itself.   [Ref.  13] 

A  better  procedure  for  obtaining  an  estimate  of  x(/)  is  to  make  the  estimate,  the 
output  of  a  dynamic  system. 

x  =  AJc  +  Bu  +  Ky  {DA) 

The  system  is  excited  by  'y'  and  input  'u'.  By  selecting  the  matrices  A,  B  ,  and  K,  the 
error  can  be  made  equal  to 


e  = 


x  = 


X   -    X 

or 

A 

X   —    X 


(Z).5) 


Let  a  differential  equation  be  equal  to 


e  =  {A  -  KQe 


(D.6) 


where 


K  = 


(D.l) 


C  =  [c„  cj, ., .,  cj 

[Ref.  9:  pp.  260-261]. 

Pole  placement  is  to  place  poles  of  the  feedback  system  at  desired  locations.  Assume 


?.lt  ?.2,  )■£,  •  •  •  • 


(Z).S) 


are  desired  eigenvalues,  and  the  characteristic  polynomial  is 


(S  -  X,)(S  -  ;.2) ...  (5  -  Ak)  =  Sk  +  a^*"1  +  . . .  +  a*  (D.9) 


In  other  words,  pole  placement  lets 


\SI(A-bG) 


=  Sk  +  a]Sk~l  + 


A 

+  a. 


(0.10) 
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multiple  input  multiple  output  systems,  G  has  1  x  k  unknowns  (  1  is  the  number  of  in- 
puts).  The  solution  of  G  is  not  unique.   Next  a  matrix  N  will  be  defined  as 


Ar=[C\A'C\  ,.,A'k~]C] 
C  =  transpose  of  matrix  C 


{DM) 


Matrix  'W  equals 


W    = 


1  a, 

0    1 
0    . 


lk-\ 


lk-2 


(0.12) 


Now  a  term  K'  will  be  defined  as 


K'  =  (a  -  d){NW) 


-l 


(0-13) 


where 


A  ["A       A  A     -I 

a  =  [a,  a2 . .  aj 
a  =  [a,  a2 . .  aj 


(DM) 


a  terms  are  the  desired  coefficients  of  the  characteristic  polynomial,    'a'  coefficients  are 
obtained  from  the  ITAE  criteria  for  a  third  order  equation  since  'a'  is  a  1  x  3  matrix. 

B.     OBSERVER  FOR  FLEXIBLE  JOINT  ROBOT 

The  system  in  this  research  will  be  described  by  the  following  state  space  represen- 
tation: 


An    A12 


A 


22 


+ 


B, 


B- 


>u    + 


{DAS) 
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Now  make  the  following  relationships: 


z,  =  e 


z2  =  e 

z,  =  z2 

z3  =  e 

z2  =  z3 
z3  =  z4 

z4  =  e 

(Z).16) 


From  Equation  (4.3) 


zA  =  6  « 


tf 


J/V/J/J 


r- 


k 


J/wJ/4 


/ 


(0.17) 


x,    = 


*2     = 


{z,} 

=   (0) 

Z2 

V 

z3 

= 

0 

_Z4. 

0 

Substituting  values  into  equation  (D.15),  results  in  the  following  equation: 


Z] 

Z2 
Z3 

Za 


- 

0  10  0 

Z] 

0 

0 

0  0  10 

z2 

+ 

0 

T  - 

0 

0  0  0  1 

z3 

0 

0 

0  0  0  0 

z4 

K 

K 

L^  J 

J 

/ 


(Z).  18) 


Referring  back  to  equation  (D.15), 


An  is  a  1  x  1  matrix 

A12  is  a  1  x  3  matrix 

A21  is  a  3  x  1  matrix 

A22  is  a  3  x  3  matrix 
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Expanding  equation  (D.15)  results  in  the  following 


x2  =  A22x2  +  A21Xj  +  B2w  +  f2 
-/,  +  x,  -  Anx,  -  B,u  =  A12x2 


(D.19) 


An  observer  is  designed  as 


x2  =  A22x2  +  [A2jX,  +  B2w  +  /2] 

y  -  Cx2 

where    y  =  —  fx  +  Xj  —  Anx1  -  B,w 

C  -  AI2 


(D.20) 


Redefining  equation  (D.19)  results  in 


x2  =  A22x2  +  A21Xj  +  B2u  +  f2 

+  L[xj  -  Anx,  -  B,u  -/,  -  A12x2] 


(D.21) 


x2  —  x2  —  x2 
x2  =  [A22  —  £A12J  x2 


(D.22) 


As  't'  -»  oo    X, 


0. 


C.     NUMERICAL  SOLUTION 

Using  the  values  provided  in  equation  (D.18),  the  solution  to  equation  (D.10)  is 


si  —  A  |   =  s3  +  0  +  0-0-0-0 
a!  =  0    a2  =  0    a3  =  0 


(0.23) 


where 


CT  = 


AT  = 


"o 

0 

o" 

1 

0 

0 

0 

1 

0 

From  equation  (D.ll)  and  equation  (D.12) 


N  = 


1 

0 

o" 

0 

1 

0 

0 

0 

1_ 

NW  = 


"l 

0 

0~ 

0 

1 

0 

0 

0 

1 

INV(NW)  = 


"l 

0 

o" 

0 

1 

0 

0 

0 

1 

—    [«!»    32,    a3J 


The  coefficients  for  the  a,  terms  were  selected  from  the  ITAE  criteria  table  for  a 
third  order  characteristic  equation.  The  values  selected  were  a,  =  1.75w„, 
a2  =  2.15co^,a3  =  l.Oc^.   [Ref.  8:  pp.  129-130].   Equation  (D.  13)  now  equals 

K'  =  [l.75o)„  2.15w^  l.OOwJ] 

Looking  back  at  equation  (D.21),  let  K  =  L. 

A  block  diagram  of  the  observer  is  shown  in  Figure  8  and  in  Figure  9. 
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APPENDIX  E.     GRAPHS  OF  ADDITIONAL  SIMULATIONS 

A.  GRAPHS  WITH  NO  ADDED  MASS 

1.  Rigid  Body  with  no  load 

The  graphs  for  motor  feedback  with  no  damping  and  a  load  of  1.36  kg  and 
a>n  =     3  are  shown  in  Figure  51,  Figure  52,  and  Figure  53. 

2.  Flexible  Body  with  no  load 

The  graphs  for  flexible  body  with  no  damping  and  a  load  of  1.36  kg  and 
a>„  =     4  are  shown  in  Figure  54,  Figure  55,  and  Figure  56. 

B.  GRAPHS  WITH  AN  ADDED  MASS  OF  1.36  KILOGRAMS 

1.  Rigid  Body  Model  with  Added  Mass 

For  the  examination  of  the  Rigid  Body  model  graphs  with  damping  and  added 
mass  under  going  point  to  point  control  see  Figure  57  and  Figure  58  for  cu„  =  1  and 
Figure  59  and  Figure  60  for  co„  =    3. 

2.  Flexible  Body  Model  with  Added  Mass 

For  an  examination  of  the  Flexible  Body  Model  experiencing  point  to  point 
control  and  added  mass  see  Figure  61  and  Figure  62  for  a>n  =  2  and  Figure  63  and 
Figure  64  for  co„  =    4. 

C.  GRAPHS  WITH  AN  ADDED  MASS  OF  2.5  KILOGRAMS 

1.     Rigid  Body  Model  with  Added  Mass 

For  the  examination  of  the  Rigid  Body  model  graphs  with  damping  and  added 
mass  undergoing  point  to  point  control  see  Figure  65  and  Figure  66  for  co„  =  1  and 
Figure  67  and  Figure  68  for  co„  =    3. 
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Figure  51.      Rigid  Body  Model  (motor  feedback)  (0,)  wn  —    3 


CM 


O 


to 

u 

10 

T — 

to 

V 

E 

O 

o 

II 

CO 

V) 

N 

tD 


K> 


I—     c 


o 

CD 


01 


Csl 


O 


95 


ID 


- 

- 

- 

- 

_ 

— 

I 

- 

•    1 

■    ' 

1 — 1 — 1 — 

1 — 1 — 1 — 1 

1 — t — I — 

— 1 — 1 

1    1 

'                   1 

i  i 

i  i  i 

A  : 

<N 


O 


CO 


O 
II 
to 

V) 

cr 
°    O 

a> 
n 


a> 


K> 


_   id 


_   -tf 


I—     c 


O 
CD 


CN 


O 


O 

o 

Csl 


o 
o 


O 
O 

CO 


o 
o 
in 


o 
o 


o 

o 


o 
o 


o 
o 


o  o 

o  o 

n  id 

I  I 


(^9^uj-uoV'A9u)      znbjo± 


Figure  52.      Rigid  Body  Model  (motor  feedback)  (torque)  wK  =    3 
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Figure  53.      Rigid  Body  Model  (motor  feedback)  (small  motion)  iom  -    3 
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Figure  54.      Flexible  Body  Model  (0J  wK  =    4 
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Figure  55.      Flexible  Body  Model  (torque)  w,  =    4 
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Figure  56.      Flexible  Body  Model  (small  motion)  w„  —    4 
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Figure  57.      Rigid  Body  Model  (torque)  wn  —    1 
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Figure  58.      Rigid  Body  Model  (small  motion)  o)„  =     1 
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Figure  59.      Rigid  Body  Model  (torque)  w,  =    3 
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Figure  60.      Rigid  Body  Model  (small  motion)  to,  =    3 
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Figure  61.      Flexible  Body  Model  (torque)  wm  —    2 
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Figure  62.      Flexible  Body  Model  (small  motion)  wH  =    2 
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Figure  63.      Flexible  Body  Model  (torque)  a>„  =»    4 
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Figure  64.      Flexible  Body  Model  (small  motion)  wK  —    4 
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Figure  65.      Rigid  Body  Model  (torque)  wm  —    1 
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Figure  66.      Rigid  Body  Model  (small  motion)  tu„  ■    1 
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Figure  67.      Rigid  Body  Model  (torque)  wH  =    3 
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Figure  68.      Rigid  Body  Model  (small  motion)  w,  -    3 
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2.     Flexible  Body  Model  with  Added  Mass 

For  an  examination  of  the  Flexible  Body  Model  experiencing  point  to  point 
control  and  added  mass  see  Figure  69  and  Figure  70  for  co„  =  2  and  Figure  71  and 
Figure  72  for  co„  =    4. 

D.     GRAPHS  UNDERGOING  TRAJECTORY  TRACKING 

1.  Rigid  Body  Model  Experiencing  Trajectory  Tracking 

For  the  examination  of  the  Rigid  Body  model  graphs  with  and  without  damping 
and  added  mass,  under  going  trajectory  tracking  see  Figure  73  and  Figure  74  for 
a>„  =     1.   See  Figure  75  and  Figure  76  for  co„  =     1  with  damping  and  added  mass. 

2.  Flexible  Body  Model  Experiencing  Trajectory  Tracking 

For  the  examination  of  the  Flexible  Body  model  graphs  with  and  without 
damping  and  added  mass,  under  going  trajectory''  tracking  see  Figure  77  and  Figure  78 
for  co„  =    2.   See  Figure  79  and  Figure  80  for  o>n  =    2  with  damping  and  added  mass. 
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Figure  69.      Flexible  Body  Model  (torque)  co.  =*    2 


114 


UD 


i  :  : 

: 


m  -t  M->  cm  i- 

o  o  o  o  o 

o  o  o  o  o 


(N 


o 


_     DO 


10 

O 
o 


_    CN 


O 


O 
O 


O 

o 


to 
o 
o 


C71 

IT) 

(N 

II 
to 
to 
D 

E 


q 

II 

D 
-^ 

M 


a>   cm 
E     II 


D 


T7 

O 

CD 

a.' 


(SUDIPDJ)         D^PQ 


Figure  70.      Flexible  Body  Model  (small  motion)  iy„  =    2 
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Figure  71.      Flexible  Body  Model  (torque)  w„  =    4 
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Figure  72.      Flexible  Body  Model  (small  motion)  w„  =    4 
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Figure  73.      Rigid  Body  Model  (torque)  w„  =     1  (ramp) 
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Figure  74.      Rigid  Body  Model  (small  motion)  w,  =     1  (ramp) 
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Figure  75.      Rigid  Body  Model  (torque)  load  wm  =     1  (ramp) 
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Figure  76.      Rigid  Body  Model  (small  motion)  load  tt>„  =     1  (ramp) 
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Figure  77.      Flexible  Body  Model  (torque)  wK  =    2  (ramp) 
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Figure  78.      Flexible  Body  Model  (small  motion)  w,  =    2  (ramp) 
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Figure  79.      Flexible  Body  Model  (torque)  load  a>„  =    2  (ramp) 
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Figure  80.      Flexible  Body  Model  (small  motion)  load  w,  =    2  (ramp) 
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